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[57] ABSTRACT 

A motion controller and a method of controlling the motion 
of a plurality of axes which prevents a discontinuous posi- 
tion command being generated to a follower axis. A follower 
mode transfer function circuit or routine generates a position 
command in response to a master axis position. This func- 
tion can be in the form of electronic gearing or camming. A 
bias latch is utilized to offset any change in position resulting 
from a change in mode, such as changing from electronic 
gearing to electronic camming, changing Sam profiles or 
gearing ratios, or changing the master axis. The latch is 
summed with the transfer function position command and a 
standard move command profile generator position com- 
mand to provide the follower axis position command. The 
latch is recalculated each time the follower mode is changed. 
A halt command can be used to selectively block or enable 
an independent move command signal, allowing the fol- 
lower axis to remain in motion when the follower mode is 
turned off (not following the master axis), or allowing the 
follower mode to be turned on while the follower axis is in 
motion without a sudden change in position. Trigger calcu- 
lation circuitry is used to precalculate timing for activating 
the follower mode when follower mode is changed from off 
to on while the follower axis is already in motion such that 
the axes are in phase after ramping time. 

24 Claims, 9 Drawing Sheets 
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ELECTRONIC GEARING FROM/TO NON- follower axis when a follower mode is changed. The motion 

ZERO FOLLOWER MOTION WITH PHASE controller includes a move profile generator which generates 

ADJUST a move profile position value or command, a transfer func- 

TFrHNnr at rift n ^ on P os ^i° n generator which generates a transfer function 

5 position value, and a latch which generates a bias position 

The present invention generally relates to a motion con- value. The move profile position value, the transfer function 

troller and a method for controlling a plurality of axes, and position value and the bias position value are provided to a 

more particularly to a motion controller and method for command summer which generates a follower axis position 

controlling the motion of a follower axis which moves in value or command in response to the move profile position 

response to the position of a master axis, wherein the io value, the transfer function position value and the bias 

follower axis is able to remain in motion at a specified position value. The follower axis position value controls the 

velocity when the follower mode is changed from on to off, position of the follower axis. 

the follower mode can be changed from off to on while the b j as p 0S j t i 0 n value offsets a change in the transfer 

follower axis is in motion without a discontinuous jump in function position value resulting from a change in the 

follower axis position, and the master and follower axes can 15 follower mode. That is, the bias position value cancels any 

be automatically placed in synch when the follower mode is disruption to the follower axis position command when the 

changed from off to on, regardless of follower axis motion. follower mode transfer function is changed. The bias posi- 

BACKGROUND OF THE INVENTION ^on va ^ uc * s calculated in response to a change in the 

^ _ . . , follower mode. 

There are a variety of applications which require synchro- on ^ „ 

nized motion between a plurality of components. In such ™ e move P rofile generator generates a move profile value 

environments, each component is typically referred to as an or command which smoothly moves the follower axis in 

axis. Movement of an axis may be rotational, linear, or some with the master axis. As is understood m the art, the 

other more complex motion. movc P rofile g enerator can function to slowly ramp the 

c n ,. M _ a • . „ tMi ■ ^ enr%nea t „ follower axis up to the desired speed, and slowly ramp the 

Some applications require one axis to move in response to 15 f „ , ^ . 

. . , , 1 . . . . follower axis down to zero. I tie move profile generator can 

another axis, such as electronic gearing, or electronic cam- . _ . A ~r ' „ ■ ♦ r ..... 

T . r f . _ 4 . also function to move the follower axis in phase with the 

ming operations. In such applications, for example, a motion mas ter axis 

controller can be used to move a follower axis in response m er a 

to the position of a master axis. nc transfer Action position generator generates the 

Many motion controllers provide electronic gearing and 30 transfer function position value in response to a master axis 

camming features in their products. For example, Schneider P oslUon value ' In ™. mode of °P**™> *t transfer 

Automation Modicon motion controllers provide electronic ^ nctl0 ° P° sluon vake 15 a multl P her value toes 

gearing or camming. The 3220/3240 CyberBasic motion the master a ™ f 051110 " value (i.e. electronic gearing). This 

controllers also feature both gearing and camming. constant mulUpher vake can be changed from a first value 

However, the CyberBasic controllers requires users to posi- 35 t0 a value ' ™ e u bias Position value changes m 

tion the follower axis in the correct position before turning res P onsc to a chaQ S e in constant multl P hcr value ' 

the camming "on/' Other known controllers, such as the In another mode of operation, the transfer function posi- 

QMOT and BMOT single axis controllers, feature electronic tion generator includes a first transfer function lookup table 

gearing but not camming. which provides a first transfer function position value in 

Certain problems exist for motion controllers capable of 40 response to a particular master axis position value (i.e., 
changing modes Adof operation. As in the CyberBasic electronic camming). The mode can be changed so that the 
motion controllers, users are required to position a follower |. ran ? fer Action position generator includes a second trans- 
axis prior to turning a particular mode "on." In other * r looku P which P r0Vldes a sccond lrmfcr 
controllers, changing the mode abruptly changed the desired P oaUon value m res P onse to me Particular master 
position of the follower axis, which immediately attempted 45 axis P oslUon value The bias position .value changes in 
to move to the new models desired position. This created a [ es P onse ^ohmge from the first lookup table to the second 
jerk in the movement which could wear or damage the axis. lookup table. 

Prior controllers lack mechanisms for allowing a follower ^ follower mode can change by turning the following 

axis to continue to move at a specified rate after a command mode ' on " 01 " off " ™ c follower mode can also change by 

has been issued to turn the follower mode "off," (command 50 changing the value of the constant multiplier of the transfer 

the follower axis to stop responding to the master axis), or function, or changing the lookup table. Additionally, the 

to allow the follower mode to be turned "on" while the follower mode can change by switching from an electronic 

follower axis is in motion without causing sudden jumps in gearing operation to an electromc camming operation, or 

follower axis position. Furthermore, prior controllers ^ om an electronic camming operation to an electronic 

required that out of phase axes be manually adjusted after 55 gearing operation, or by changing the master axis to a new 

turning the follower mode "on" in order to synchronize master axis - In each case > lhe bias position value is calcu- 

them, or to require the follower mode to be turned on from Iatcd t0 offiset a discontinuous follower axis position value 

a follower axis stopped state only. bein g generated. 

The present invention provides a motion controller and a In a broader sense, the invention provides a motion 

method of controlling the motion of a follower axis which 60 controller including circuitry for generating a first position 

does not require a user to position the follower axis prior to vahie in response to a first axis position value, and circuitry 

turning a mode "on," and which prevents a jerk in movement for generating a second position value which offsets a 

when changing modes. change in the first position value due to a change in a mode 

of operation of the circuitry for generating a first position 

SUMMARY OF THE INVENTION 65 value motion cq^oUct also includes circuitry for 

The present invention is directed to a motion controller generating a second axis position value in response to the 

which prevents a discontinuous position command to a first position value and the second position value. As used 
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herein, the "circuitry" can be either hard wired, a software response to the master axis position value; generating a bias 

routine, or any combination thereof. position value which offsets a change in the transfer function 

The motion controller can further include circuitry for position value due to a change in the follower mode; and 

generating a third position value for moving the second axis generating a follower axis position value in response to the 

in synch with the first axis. In this case the circuitry for 5 move profile position value, the transfer function position 

generating a second axis position value generates the second value, and the bias position value. The move profile position 

axis position value in response to the third position value in value and & & transfer function values can be ramped from 

addition to the first position value and the second position starting values to ending values in response to a change in 

value. halt command or follower axis mode, and the ramping rates 

The invention also includes a method of preventing a 10 can be equalized. Additionally, a triggering time based on 

discontinuous position command to a follower axis when a ^ present position and velocity of the follower axis can be 

follower mode is changed. The method includes the steps of precalculated, wherein the follower axis and the master axis 

providing a master axis position value and generating a are placed in synch after the ramping of the transfer function 

transfer function position value in response to the master position value and the ramping of the move profile position 

axis position value. The method also includes generating a 15 value when ^ follower axis mode is activated according to 

move profile position value, generating a bias position value Ac tri gg erin S ^ thereby enabling the follower mode to be 

which offsets a change in the transfer function position value activated while the follower axis is in motion, and the axes 

due to a change in the follower mode; and generating a will be in synch without further adjustment, 

follower axis position value in response to the move profile Further aspects of the invention are described in the 

position value, the transfer function position value, and the 20 detailed description of the preferred embodiment and the 

bias position value. claims, and are shown in the drawings. 

The motion controller and method of the present inven- _ 

tion avoids the standard problem with electronic camming BRIEF DESCRIPTION OF THE DRAWINGS 

(and electronic gearing when implemented in a positional pjG. \ & a bl^k diagram of a motion controller of the 

mode rather than a velocity mode) of requiring the position present invention- 

of the follower axis to be in the correct position when pio, 2 is a block diagram of the new mode decision 
camming (or positional gearing) is turned on. algorithm- 
It is sometimes desirable to enable a follower axis to * , . . c c , , a 
. . /j j i £*ii j FIG. 3 is a block diagram of the follower mode on/off 
continue to move at a specified rate once the follower mode - n , . . . ^ 

is turned "off." For example, if the motion controller is 30 de ™ al S ontbm ; 

operating a conveyor belt system in which articles to be FIG - 4 15 a block diagram of the gearing mode algorithm; 

packaged are moved via a master axis, and packaging FIG. 5 is a block diagram of camming mode algorithm; 

material is disposed upon the articles via a follower axis, if FIG. 6 is a block diagram of the command summer 

the system must be taken off line, it may be desirable to keep 35 algorithm; 

both axes moving so that items are not backed up. The FIG. 7 is a block diagram of the following off mode 

motion controller of the present invention includes an inde- algorithm; 

pendent move command to provide input for the standard 0 . . . , ,. - . . . . . 

v , * c u • * u i FI G - 8 is a block diagram of the pomt lock triggering 

move command profile generator. Such input may be selec- ^ orithnr and 

tively blocked or enabled by a halt command. By choosing 40 ' 

to enable the input when the follower mode is turned off, the FIG - 9 « a block diagram of a further embodiment of the 

input may be used to allow the follower axis to continue motlon controller of the present invention, 

movement independent of the master axis. DETAILED DESCRIPTION OF THE 

Furthermore, the halt command may be activated to block PREFERRED EMBODIMENT 

the independent move command signal when the follower 45 

mode is turned on from a moving state without the follower While this invention is susceptible of embodiments in 

axis suddenly jumping in response to a sum of the current many different forms, there is shown in the drawings and 

velocity and the transfer function output. will herein be described in detail preferred embodiments of 

The motion controller of the present invention can also tne invention with the understanding that the present dis- 

include trigger calculation circuitry which enables the axes 50 closure is to be considered as an exemplification of the 

to be automatically placed in phase after the follower mode principles of the invention and is not intended to limit the 

is turned on from a moving state of the follower axis. The broad aspect of the invention to the embodiments illustrated, 

calculation takes into account ramping rates and present In its preferred form, the present invention is described in 

parameters to precalculate the timing needed for the fol- terms of controlling an axis which follows, or moves in 

lower mode to be turned on such that the axes are in synch 55 response to the position of another axis. However, the 

after ramping to speed. principles discussed can be used to control more than one or 

The invention further provides for a method of selectively two axes. An axis represents a range of physical movement 
enabling a follower axis to remain in motion when a of an element (e.g., a gear, or assembly line track). Move- 
follower axis mode is deactivated, and enabling the follower rnent of an axis can be linear, rotational, or even more 
axis mode to be activated while the follower axis is in 60 complex positioning of a tool or device, 
motion without a discontinuous position command to the The motion of a first, or master axis, is controlled or 
follower axis. The method includes the steps of generating monitored to provide a position value at a given moment. A 
an independent velocity value; generating a halt command; second, or follower axis, when utilizing a follower mode of 
generating a follower axis mode signal; generating a move operation, is controlled to move in response to the position 
profile position value in response to the independent velocity 65 of the master axis. That is, a transfer function is applied that 
value and the halt command; providing a master axis posi- takes a master axis position and produces a desired follower 
tion value; generating a transfer function position value io axis position. The follower mode of the follower axis is 
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preferably in the form of electronic gearing or electronic follower mode. As explained above, changes in the follower 

camming. However, other modes can be utilized. mode are turning it "on" or "off," changing the cam profile 

Electronic gearing occurs when the follower mode trans- 10 a different profile, changing the gearing ratio to a different 

fer function ("G(master axis position), or G(M)") is a rano > changing from camming to gearing or gearing to 

constant multiplier ("R") times the master axis position: 5 camming, and changing the master axis. A cam profile can 

G(M)=Rxmaster axis position chan 6 c b y changing from a first profile stored in memory to 

The gearing ratio is changed by changing the value of the a s ! cond P rofile stored m * c memory. Alternatively, the 

constant multiplier R. ~ ~ P rofilc can ch^g* b y writing over a first profile with a 

Electronic camming occurs when a cam profile is stored second profile at the same memory location, 

in a lookup table that relates the desired follower axis 10 The mtelligent latch 16 generates a bias output value that 

position for a given position of the master axis. In this cancels or offsets the change in the transfer function position 

instance, the follower mode transfer function is: valuc that occurs from mc chan S e m follower mode. For 

G(M)=Looku P Table(master axis position) follower mode changes from "off' (G-0, 

Missing points in the table can be filled in by interpolating c ™- f'S w ^T™"' l^ut* 

. , . . . . / 4 *. . r, & is intelligent Latch calculates the bias as B— F. With this 

such points from given points in the lookup table. For va i ue - 

example, a linear or cubic interpolation can be utilized with 

given points in the lookup table to provide a transfer p-c+f+(-f)-c 

function position value for a master axis position value 

which is not one of the given points in the lookup table. Accordingly, there is no change in the value of P resulting 

A change in the follower mode can result in a discontinu- from turning the follower mode "on" no matter what the 

ous position value being generated to the follower axis. The master axis position value M, or the transfer function 

follower mode can change by simply turning the follower position value F are for the follower mode. This prevents 

mode "on" and "off." Alternatively, the follower mode can generating a discontinuous position command to the fol- 

change by switching between electronic gearing and elec- lower axis when the follower mode is turned "on," and 

tronic camming, changing the gearing ratio, changing the avoids the need to position the follower axis to the correct 

cam profile lookup table, or changing the master axis. The position before turning the follower mode "on" to avoid a 

present invention prevents the follower axis from attempting jerk in the follower axis. 

to immediately jump to the desired position according to the More generally, when the transfer function is changed to 

new mode selected. 3Q a new transfer function G new) from some previous transfer 

Referring to FIG. 1, a motion controller 10 is graphically function G prev (i.e., a change in the follower mode), the 

represented in block diagram format. The controller 10 intelligent latch 16 calculates a new bias value B such that 

includes a follower mode transfer function circuit 12, which there is no change in the follower axis position command P 

can be either hard wired or a software routine. The follower when using the new transfer function by using: 

mode transfer fuaction circuit generates a desired position ^ 

value or command ("F") in response to a first, or master, axis P^-C+G^^^M^+B^ 

position value or command ("M"). Depending on the current ^ ^ e rev ious transfer function and 

follower mode selected, the transfer function position value 0r e P revious ^ s er nc on > m 

F can be the result of an electronic gearing operation, an p„«,=c+g„,*,(m W )+B rtrw ; 
electronic camming operation, or any other operation which 

depends on the master axis position. That is: 40 for the new transfer function. Where to avoid a position 

F=G(M) change at the time the mode changes (i.e., have P^^-P^, 

The controller 10 further includes a standard move com- for the last position sample time), the latch calculates a new 

mand profile generator circuit 14. This circuit generates a bias as: 

move profile value or command ("C") which smoothly 45 r r nvi vr fM ^ r 

moves the follower axis in addition to the motion resulting ».~<W^>^^^^«W 

from applying the transfer function to the master axis This calculation is also used to allow a master axis to be 

position M. changed to a new master axis which may be at a different 

The controller 10 also includes an intelligent bias calcu- position than the previous master axis position M pnrv . 

lation latch circuit 16 which outputs a bias value or com- 5Q The above equations still apply, but in this instance the 

mand ("B")- The latch receives input as to changes in the transfer functions G prev and G^ have not changed and the 

follower mode, and the transfer function position value F. master axis position is retrieved from a different master axis 

Finally, the controller 10 includes a command summer 18, S0 : 
which receives as inputs the transfer function position value 

F as a first position value, the bias value B as a second 55 p^-c+g^^Cm^+b^ 

position value, and the move profile position value C as a e ... 

third position value. The summer 18 generates a second, or for ue P rev,ous master 4X18 P 0Sltl0n > ^ 

follower, axis position value or command ("P") in response p^-c+G ^XH^J+B,,^ 

to these inputs. Specifically, the equation of motion for the 

follower axis position value P as given in FIG. 1 is the sum 6Q for the new master axis position. Where to avoid a discon- 

of the transfer function position value F, the move profile tinuous position change (again, have P prm} rP mWt for the last 

position value C, and the bias output B from the intelligent position sample time) the latch calculates a new bias value 

bias calculation latch, or: as: 

P-F+C4B. B^^Jlp W )-G^(Mj+B^ 

65 

The intelligent latch 16 calculates a bias value B which The addition of the intelligent bias latch 16 in the con- 
offsets the change in position resulting from a change in the troller 10 allows changes in the follower mode transfer 
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function to be accomplished with no disruption to the effect on output "C " and thus "C" would remain constant, 
follower axis position commands. Additionally, such A default setup might specify that when the follower mode 
changes in the follower mode can occur while the follower is turned "off", that "H" will be "on." Thus, "C" will be 
mode is "on" and the follower axis and master axis are constant, T will be zero, and "B" will be constant, result- 
moving. Specifically, the addition of the latch means the s ing in the follower axis ceasing to move. The feature allows 
follower axis does not have to be in the correct position to "H" to be configured such that when the follower mode is 
avoid jerks in the motion when changing the follower mode. turned "off," "H" is also "off," and "C is then affected by 
This can prevent damage to a follower axis resulting from "V." Since "F" would be zero, and "B" would be constant, 
attempting to jump to a new desired position due to a change the follower axis would be affected by "C" and would 
in the follower mode. 10 continue to move at the specified rate. It is understood that 

The motion controller can be configured to run through a when the follower mode is changed from "on" to "off," the 

number of algorithms to implement the functions described transfer function 12 ramps down during a deceleration 

above. For example, every 2 milliseconds the controller can period, and when "H" is changed from "on" to "off," the 

check the status of the mode and the position commands and standard move command profile generator 14 ramps up 

implement any modifications necessary. 15 during an acceleration period. The ramping rates may be 

FIGS. 2-8 show the algorithms run by the controller 10. synchronized such that a smooth transition occurs. 

FIG. 2 shows the algorithm which determines whether a new Another advantage of allowing "H" to be configured is 

mode is selected. The controller can switch the follower that "H" can be turned "on" when the follower mode is 

mode from "on" to "off" 20 or from "off" to "on" 22, change turned "on." Once "H" is turned "on," "C" will be constant, 

the ratio of the gearing 24, change the cam profile 26, or 20 and "F" will be generated by the transfer function 12. In this 

switch the master axis 28. The change ratio 24 and switch manner, the follower axis position command "P" will not 

cam 26 decisions, can change the mode to the desired experience a sudden increase as a result of summing "C" and 

gearing ratio or cam profile, from any other mode the "F' when the follower mode is turned "on" from a follower 

follower mode is in. As discussed further below, the halt axis in-motion state. Thus, the follower mode can be turned 

conditions can be configured 30 as well. 25 "on" without stopping the axis prior to this change of mode. 

FIG. 3 discloses the algorithm for changing the follower Again, when "H" is turned "on," "V" is ramped down during 

mode "on" and "off." FIGS. 4 and 5 show the algorithms for a deceleration period, according to a deceleration term, and 

the gearing mode and camming mode, respectively. FIG. 6 "F' ramps up during an acceleration period, according to an 

shows the algorithm for the command summer 18. FIG. 7 acceleration term. The rates of the deceleration term and 

shows the algorithm for turning the follower mode "off." 30 acceleration term can be equalized such that "P" will not 

FIG. 8 shows the point lock trigger algorithm which is experience sudden changes. 

described in detail below. A further feature of the invention is the addition of trigger 

In a further feature of the invention, referring to FIG. 9, calculation circuitry 36. If the follower axis is in a moving 

an automatic triggering and follower mode control 32 pro- state, but not following the master access (follower mode is 

duces a follower "on" or "off" enabling signal "O," received 35 turned "off 1 '), the follower mode can be turned "on," while 

by the transfer function circuit 12, and a halt "on" or "off" simultaneously turning the "H" command "on." "P" is then 

command "H," received by the standard move command following "F," however, the follower axis may be out of 

profile generator 14. It may be desired to rum the follow synch with the master axis. The trigger calculation circuitry 

mode "off" such that the follower axis no longer responds to 36 takes all the current parameters into account, including 

the master axis, however, allow the follower axis to continue 40 the ramping terms, and determines at what time to turn the 

at its current velocity (or other specified velocity). follower mode "on" such that after the ramping, the master 

An independent move command 34 produces' a velocity axis and the follower axis will be in synch with one another, 

output "V" (representing a current follower velocity or other The following is an example of an algorithm for performing 

specified velocity) which is received by the standard move the triggering calculation, which one of ordinary skill in the 

command profile generator 14. When "H" is "off," the 45 art could readily surmise from the flow charts, the other 

standard move command profile generator 14 allows "V" to functions having code similarly surmisable from their 

affect the output "C " However, if "H" is "on," "V" has no respective flow charts: 



calcTriggerPoktLock(FollowerSet& fset, Axis& master, Axis& slave, PositionTJnits master_vel, 
Position Units slave_vel, 

PositionUnits& phase_adjust, PositionUnits& trigger, REAL& lock_time) 
// this function calculates a trigger point on the master axis such that the slave is in point 
// lock mode with a phase_adjust amount 

// Assumptions: 1) master is not a rollover axis. This allows the trigger to be set for more than one rev. 



// 2) the slave does have rollovers set at 0-360 degrees 

// 3) BOTH axes are rotary axes. 

// 4) the phase_adjust is how much the master axis leads the slave 

// 5) the master moves at a constant velocity 

// 6) the slave is moving at a constant velocity 

// 7) the motion engine's internal units for rotary axes is revs 

// 8) master and slave are going in same direction 



// RETURNS: this function returns how long it will take to achieve the point lock into the lock_time 
// variable. It returns TRUB as the return value, if the calculates say it can make the lock. It 
// returns FALSE if it cannot calculate and achieve point lock. Note that 
// when the mastcr_vel and slave__vel arc the same value, the time to achieve point lock mode 
// goes to infinity. This function will return FALSE, with a very large time in that case. 
// STRATEGY: this algorithm allows the axis to go into point lock mode by keeping the 
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// master and slave moving at their speeds until the master and slave get within the acceleration 

// distance of each other, and then it accels up to the lock position. Since this is an open 

// loop calculation and relies somewhat on the sampling of the master and slave positions 

// being on same SERCOS tick (if off then that effects the accuracy of the lock), the lock 

// position will be somewhat dependent on velocity and the SERCOS tick clock, m testing, the 

// lock seemed to be good to 1-2 SERCOS ticks times the velocity of the slave. This strategy of 

// waiting has the effect that if the slave is going at 0 speed, it waits until the master is just 

II about to pass it, and then it accels. If they are both going at the same speed, then the master 

II will never pass it, hence the check on the velocitys being the same (corrected by the follower__ratio). 

// allow for a non 1:1 FollowerRatio*» slave moves/master_moves 

Ratio r = fseLgetFollowerRatio(slave); 
REAL reaLjatio » r.getNumerator( ).getlnternal( )/r.getDenominator( ).getlntemal( ); 
II first check for equal velocities 
if ((real_j^tio*master__vel) « slave_vel) 
// does an automatic epsilon compare 

lock_time = FLT_MAX; 

return boolFalse; 
// we need the speeds for later 

REAL speed_from_master = fabs(real__ratio * master_vel.getlntcrnal( )); 

REAL speed from_slave = fabs(slave_vel.getlnternal( )); 

// compute the difference in the slave velocity and masters 

REAL delta_v = real_ratio*master_vel.getIntemal( ) - slave_vel.getlntemal( ); 

REAL accel - slave. getAccel( ).getlnternal( ); 

if (delta_v < 0.0) 

accel - -accel; /Ave want a positive time. 

REAL accel time - delta_v/accel; 

// handle any roundoof 

if(accel_time < 0.0) acoeL_time - 0.0; 

// now capture where the 2 axis are located right now. 

REAL pos_master_now - master.getUnrolledPosition( ).getlnternal( ); 

REAL pos_slave_now = slave. gctPosition( ).getlnternal( ); 

// the followerSet equation is «*> pos_slave - ratio * pos_mastcr + bias 

// so find out what the ratio * master term is 

REAL pos_master_gcar = pos_master_now * real_ratio 

// the master is not doing rollovers, we assume a rotary axis 0-360 and get 

// the factional rev part 

double int__part; 

REAL mod__pos = modf(pos_inaster_gear, &int_part); 

// now effectively, both positions are 0 based so bias is 0. Find positional difference 
REAL pos_diff=pos_slave_now - mod_pos; 
// adjust for any phase adjust 

REAL pos_slip = pos_diff + real_jatio*phase_adjust.getInternal( ); 

// this is algorithm that waits for the master and slaves phasing relationship (remember 

II that they are both moving at different velocities so there relative positions to each 

// other are constantly changing) to come around to near where point_lock mode is adjusted 

//by the accel time. 

REAL slip_time = (pos_slip/delta_v) - 0.5 " accel_time; 
// and now compensate for the accel/decel ramp canceling out 
if (speed_from_slave > speed_from_master) 

slip_time -= fabs(speed_from__master_accel); 

else 

slip_time — fabs(speed_from_slave/accel); 
// the above time can be negative but real time cannot, so if we simply add on how long 
// the relative phasing of the master to slave from different velocities takes to get them 
1} back to these same rolled positions, we can get the time to be positive. In addition 
// we want it greater than how long we can take to accel. Plus it has taken us some 
// time to do these calculations, bo we make the time be longer than 2 accel times 
REAL one_rev_time - 1.0/fabs(delta_v); 

REAL two accel Umes - 2.0 • accel time; 

while (slip_time < two_acceL_times) 

slip time +• one_rev_time; 

II the trigger position is the velocity * the slip_time away since at constant vel 
trigger - rev(pos_master_now + master_vel.getlnteraal( )*slip_time); 
lock__time - slip_time; 
return boolTrue; 



While the specific embodiments have been illustrated and 
described, numerous modifications come to mind without 
significantly departing from the spirit of the invention, and 
the scope of protection is only limited by the scope of the 
accompanying ;Claims. 

I claim: 

1. A motion controller which enables a follower axis to 
selectively remain in motion when a follower mode is 
deactivated, and which enables the follower mode to be 



activated while the follower axis is in motion without a 
discontinuous position command to a follower axis com- 
prising: 

an independent move command which generates an inde- 
pendent velocity value; 

a move profile generator which generates a move profile 
position value; 

a transfer function position generator which generates a 
transfer function position value; 



60 
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an automatic triggering and follower mode control which 
generates a follower enabling signal for selectively 
turning the follower mode on and off, and which further 
generates a halt command; and 

a summer which generates a follower axis position value 
in response to said move profile position value and said 
transfer function position value, 

wherein the halt command can be configured with respect 
to the follower enabling signal to selectively enable the 
move profile generator to incorporate the independent 
velocity signal into the move profile position value. 

2. The controller of claim 1, further comprising a latch 
which generates a bias position value, wherein said summer 
generates said follower axis position value in further 
response to said bias position value. 

3. The controller of claim 1 wherein said transfer function 
position generator generates said transfer function position 
value in response to a master axis position value. 

4. The controller of claim 3 wherein said transfer function 
position value is a constant multiplier value times said 
master axis position value. 

5. The controller of claim 1, wherein the halt command is 
configured to change to off when the follower enabling 
signal is changed to off, and wherein the move profile 
generator responds to the halt command changing to off by 
ramping during a first acceleration period from a current 
output level to a new output level, and wherein the transfer 
function position generator responds to the change in the 
follower enabling signal to off by ramping during a first 
deceleration period from a current transfer function position 
value to a new transfer function position value, such that the 
follower axis is able to remain in motion at a specified rate 
when the follower mode is changed to off. 

6. The controller of claim 5, wherein the first acceleration 
period and the first deceleration period are substantially 
equal in duration. 

7. The controller of claim 1, wherein the halt command is 
configured to change to on when the follower enabling 
signal is changed to on, and wherein the move profile 
generator responds to the halt command changing to on by 
ramping during a second deceleration period from a current 
output level to a new output level, and wherein the transfer 
function position generator responds to the change in the 
follower enabling signal to on by ramping during a second 
acceleration period from a current transfer function position 
value to a new transfer function position value, such that the 
follower mode can be activated while the follower axis is in 
motion without a discontinuous position command to the 
follower axis. 

8. The controller of claim 7, wherein the second decel- 
eration period and the second acceleration period are sub- 
stantially equal in duration. 

9. The controller of claim 7, further comprising trigger 
calculation circuitry which calculates a triggering time for 
activating the follower enabling signal based on the current 
velocity and position of the follower axis, wherein the 
master axis and the follower axis are placed in desired 
relative position after the second deceleration period and the 
second acceleration period. 

10. The controller of claim 8, further comprising trigger 
calculation circuitry which calculates a triggering time for 
activating the follower enabling signal based on the current 
velocity and position of the follower axis, wherein the 
master axis and the follower axis are placed in desired 
relative position after the second deceleration period and the 
second acceleration period. 

11. A method of selectively enabling a follower axis to 
remain in motion when a follower mode is deactivated, and 
enabling the follower mode to be activated while the fol- 
lower axis is in motion without a discontinuous position 
command to the follower axis comprising the steps of: 
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generating an independent velocity value; 

generating a halt command; 

generating a follower mode signal; 

generating a move profile position value in response to 
said independent velocity value and said halt com- 
mand; 

providing a master axis position value; 

generating a transfer function position value in response 

to said master axis position value; 
generating a bias position value which offsets a change in 

said transfer function position value due to a change in 

said follower mode; and 
generating a follower axis position value in response to 

said move profile position value, said transfer function 

position value, and said bias position value. 

12. The method of claim 11 wherein said follower axis 
position value controls the position of a follower axis. 

13. The method of claim 11 wherein said generating a 
transfer function position value step comprises providing a 
first constant multiplier and multiplying said master axis 
position value by said first constant multiplier. 

14. The method of claim 13 wherein said generating a 
transfer function position value step comprises providing a 
second constant multiplier and subsequently changing mul- 
tiplying said master axis position value by said first constant 
multiplier value to said second constant multiplier. 

15. The method of claim 14 wherein said generating a bias 
position value step comprises changing said bias position 
value in response to said change from said first constant 
multiplier to said second constant multiplier. 

16. The method of claim 11 wherein said generating a 
transfer function position value step comprises providing a 
first lookup table which generates said transfer function 
position value in response to said master axis position value. 

17. The method of claim 16 wherein said generating a 
transfer function value step comprises providing a second 
lookup table which generates said transfer function position 
value in response to said master axis position value, and 
changing from utilizing said first lookup table to said second 
lookup table. 

18. The method of claim 17 wherein said generating a bias 
position value step comprises changing said bias position 
value in response to said changing from utilizing said first 
lookup table to said second lookup table step. 

19. The method of claim 11 wherein said generating a bias 
position value step comprises changing said bias position 
value in response to a change of said follower mode. 

20. The method of claim 19 wherein said follower mode 
changes from electronic gearing to electronic camming. 

21. The method of claim 11, wherein the step of gener- 
ating the move profile position value further comprises 
ramping the position value from a starting value to an ending 
value at a first ramping rate in response to a change in the 
halt command. 

22. The method of claim 21, wherein the step of gener- 
ating a transfer function position value further comprises 
ramping the transfer function position value from a present 
value to a new value at a second ramping rate in response to 
a change in the follower axis mode signal. 

23. The method of claim 22, wherein the first ramping rate 
and the second ramping rate are equalized. 

24. The method of claim 11, further comprising the step 
of calculating a triggering time based on the present position 
and velocity of the follower axis, wherein the follower axis 
and the master axis are placed in synch after the ramping of 
the transfer function position value and the ramping of the 
move profile position value when the follower axis mode is 
activated according to said triggering time. 
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